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Position  and  Azi^th  Determining  System  ( PADS developed  by 
Litton  Systems,  Inc.  for  the  lL.S._Army  Engineer  Topographic 
Laboratories  (ETL) .  ^Following  the  installation  of  an  improved 
vertical  accelerometer  and  other  modifications,  the  PADS  has  been 
renamed  Inertial  Positioning  System  (IPS).  The  IPS,  with  some 
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softwar*  changes  as  to  gyro  error  control  has  served  as  the 
Rapid  Gravl^  Survey  System  (R6SS)  for  ETL.  The  present  R6SS 
operates  as  a  quasi-local  level  system  and  permits  Kalman 
stochastic  error  control  using  observed  velocity  errors  at 
vehicle  stops.  A  new  optimal  data  reduction  method  for  estimatinc 
the  deflections  of  the  vertical  is  presented.  The  method 
requires  RGSS  horizontal  velocity  errors  at  each  stop  emd  the 
inertial  system  real-time  Kalman  filter  update  gains.  Storage 
of  real-tifl»  covariance  data  is  not  necessary.  Survey  traverse 
initial  and  terminal  astrogeodetic  deflections  are  utilized  along 
with  terminal  platform  azimuth  error  observation  to  estimate 
approximate  gyro  biases.  The  error  models  used  preserve  the 
inertial  system  dual  horizontal  interaction  and  exploits  statis¬ 
tical  collocation  techniques  to  preserve  correlations  between 
the  two  components  of  the  deflection  of  the  vertical  which  are 
least  squares  estimated  using  all  data  simultauieously . 
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1.0  INTRODUCTION 


1.1  BACKGROUND 

The  U.S.  Army  Engineer  Topographic  Laboratories  (USAETL)  awarded 
a  contract  to  Litton  Systems#  Inc.#  Guidance  and  Control  Systems 
Division  (LITTON  GCSD)  back  in  1966  to  determine  the  feasibility 
of  utilizing  an  inertial  navigation  system  in  a  surveying 
application  (Clark#  1966).  Subsequent  studies  (Maughmer  and 
Yamamoto#  1968;  Maughmer  and  Byrd#  1969)  led  to  the  feasibility 
and  practicality  of  the  Position  and  Azimuth  Determining  System 
(PADS) . 

Following  these  studies  the  USAETL  awarded  a  contract  to  develop 
an  experimental  PADS  in  February#  1971.  Acceptance  tests  were 
completed  in  November  1972  and  reported  on  at  the  Institute  of 
Navigation's  28th  Annual  Meeting  at  West  Point  (Huddle  and 
Maughmer#  1972).  Subsequently  Ellms  (1973)  wrote  a  report  on  the 
design#  fabrication  and  testing  of  the  PADS  which  was  capable  of 
measuring  the  change  in  horizontal  position  to  20  meters  (CEP)# 
elevations  to  10  meters  (la)#  and  azimuth  to  0.3  mils  (la)  at 
various  test  sites  in  the  continental  United  States  for  missions 
of  six  hours  duration  and  covering  distances  of  120  miles.  These 
accuracies  were  achieved  while  requiring  the  vehicle  to  come  to  a 
stop  for  only  approximately  20  seconds  following  a  travel  period 
of  roughly  10  minutes.  At  such  times#  observations  of  the 
residual  values  of  the  computed  velocities  along  all  three 
platform  axes  are  processed  by  the  PADS  real  time  Kalman  error 
control  mechanization  to  correct  system  computed  position# 
velocity#  and  platform  attitude#  and  to  compensate  various 
sources  of  system  noise.  It  did  not  require  any  external 
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position  or  azimuth  information  during  the  mission  or  at  mission 
closure  to  achieve  these  accuracies. 

Subsequently  USAETL  wanted  to  explore  the  possibility  of  using 
PADS  for  gravity  surveying.  Huddle  (1973)  examined  the 
application  of  the  PADS  to  mapping,  charting  and  geodesy  wherein 
he  concluded  that  'great  potential  exists  for  improving  the 
continuous  estimates  of  the  change  in  the  deflection  of  the 
vertical  between  the  initial  and  the  terminating  point  of  the 
mission  through  the  use  of  optimal  smoothing  techniques  which 
employ  a  deflection  change  observation  at  the  mission  termination 
point.'  For  a  one  hour  mission  this  study  showed  that  near  term 
performance  limits  of  12  to  60  cm  (la)  for  elevation,  2  to  3 
milligals  (la)  for  anomaly  and  1.5  arc  sec  (la)  for  deflection 
are  achievable  provided  that:.  1)  certain  parameter  value  changes 
were  made  in  the  real-time  Kalman  filter,  2)  vertical  A-200D 
accelerometers  were  replaced  by  the  higher  accuracy  AlOOO 
accelerometers,  3)  the  Inertial  Measurement  Unit  (IMU)  was 
isolated  or  engine  turned  off  during  zero  velocity  measurements 
and  4)  post-mission  smoothing  of  real-time  filtered  estimates 
were  performed. 

As  a  result  of  this  an  experimental  study  contract  was  awarded  to 
Litton  Systems  Guidance  and  Control  Systems  Division  in  1974  to 
determine  if  replacement  of  vertical  axis  A-200D  with  A-1000 
accelerometer  allows  determination  of  gravity  disturbance 
magnitude  to  2  milligals.  The  results  of  this  experimental  study 
indicated  that  the  running  of  engine  during  measurement  leads  to 
excessive  errors  (3  to  4  ug)  due  to  front-end  mounting  and  that 
with  engine  off  accuracies  of  1  to  2  milligals  is  achievable. 
The  results  of  this  study  was  published  by  Mancini  and  Huddle  at 
the  35th  Annual  Meeting  of  the  American  Congress  on  Surveying  and 
Mapping  in  March  1975. 
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Following  the  installation  of  the  higher  accuracy  vertical 
acceleroneter  and  other  modifications/  the  PADS  was  renamed 
Inertial  Positioning  System  (IPS).  Subsequently  in  1975  LITTON 
GCSD  was  awarded  a  contract  to  configure  the  IPS  as  a  gravity 
surveying  system  which  came  to  be  known  as  the  Rapid  gravity 
Survey  System  (RGSS) .  During  this  contract  Litton  investigated 
the  changes  necessary  to  configure  RGSS  from  IPS.  This  resulted 
in  some  changes  in  gyro  error  control  mechanization  of  the  real 
time  Kalman  filter  (Huddle,  1977).  During  this  contract  Litton 
also  examined  techniques  of  post-mission  smoothing  to  improve 
performance  and  analyzed  data  collected  by  UASETL  at  White 
Sands.  Their  results  indicated  a  potential  1.5  arcsec  recovery 
capability  with  Kalman  post-mission  smoothing.  The  first 
analysis  of  RGSS  deflection  data  obtained  by  USAETL  appeared  in 
Huddle  and  Lentz  (1976) . 

Subsequent  to  this  dqring  1977  and  1978  LITTON  GCSD  was  awarded 
another  contract  to  perform  further  analytical  studies  to  improve 
performance  of  RGSS.  The  objectives  of  this  study  were  to  reach 
performance  goals  of  1  milligal  for  gravity  anomaly  and  1  arcsec 
for  the  deflection  of  the  vertical  for  1  hour  mission  time.  This 
study  derived  deflection  recovery  performance  limitations  due  to 
integrated  correlated  drift  rate,  the  results  of  which  were 
discussed  at  the  First  International  Symposium  on  Inertial 
Technology  for  Surveying  and  Geodesy  and  also  in  a  paper  in  the 
AIAA  Journal  of  Guidance  and  Control  (Huddle,  1978) .  In  order  to 
achieve  such  performance  goals  the  study  recommended  additional 
modifications  to  the  RGSS:  1)  Super  pre-calibrate  systematic 
errors,  especially  heading  change  sensitive  effects  or  run 
straight  traverses  only  in  order  to  achieve  accelerometer  biases 
of  0.5  to  1  ug  and  gyro  drift  rate  of  0.001  deg/hr,  2)  Obtain 
better  isolation  of  system  from  random  motion  at  stops  in  order 
to  achieve  observation  accuracy  of  0.001  feet/sec  at  10  seconds, 
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3}  ensure  accurate  deflection  values  are  used  by  post-mission 
smoother  of  the  order  of  0.1  to  0.3  arcsec.  As  a  result  of  this# 
this  study  recommended:  1)  investigation  of  more  extensive  pre¬ 
mission  calibration  techniques#  2}  testing  to  determine 
systematic  content  of  heading  sensitive  instrument  errors  and 
noise  content  of  level  A-2000  accelerometers  and  3) 
modification/expansion  of  mission  data  recording  to  enable  more 
effective  post-mission  analysis. 

Following  this#  during  the  latter  part  of  1980#  USAETL  awarded  a 
contract  to  LITTON  6CSD  for  the  development#  test#  preparation# 
delivery  and  installation  of  optimal  adjustment  software  for 
inertial  survey  data.  The  objective  of  this  contract  was  to 
develop  alternative  minimum  variance  algorithms  for  simultaneous 
adjustment  of  three  axes  position  and  gravity  data  applicable  for 
single  traverse  and  multiple  traverses.  This  effort  culminated 
in  a  software  package  for  area  adjustment  of  multitraverse  R6SS 
data.  This  software  package  is  called  the  Regional  Adjustment 
Program  (RAF)  which  was  delivered  and  installed  on  the  DEC  VAX 
11/780  of  Defense  Mapping  Agency  (DMA)  geodetic  survey 
squadron.  A  series  of  reports  (Huddle#  Brockstein#  Buchler  and 
Bose#  April  1981#  June  1981a#b#  August  1982)  were  written  to 
document  the  efforts  on  this  contract.  The  conclusion  in  these 
reports  was  that  near  term  performance  goals  of  0.3  arcsec  can 
nearly  be  met  with  existing  equipment  provided  survey 
measurements  are  processed  utilizing  some  area  adjustment  program 
such  as  RAP. 

Subsequently  Baussus  von  Luetzow  (1981#  1982)  developed  a  coupled 
horizontal  channel  optimal  method  of  vertical  deflection 
determination  in  the  context  of  Litton 's  local-level  system. 
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This  study  extends  on  this  and  develops  the  algorithms  necessary 
to  implement  the  method  of  Baussus  von  Luetzow. 

1.2  PURPOSE  AND  SCOPE 

The  objective  of  this  study  is  to  review  and  analyze  astrogeo- 
detic'inertial  methods  for  determination  of  the  vertical  deflec¬ 
tions.  Methods  of  vertical  deflection  determination  developed  by 
Litton  Systems,  Inc.  and  the  O.S.  Army  Engineer  Topographic 
Laboratories  is  taken  under  consideration  to  the  extent  published 
in  the  context  of  Litton 's  local-level  system.  The  scope  of  the 
effort  is  restricted  to  the  development  of  all  the  algorithms 
necessary  so  as  to  create  the  foundation  upon  which  optimal 
adjustment  software  can  be  developed  for  large  scale  simulation 
or  actual  field  data  processing.  The  scope  of  the  study  does  not 
include  any  software  development  but  to  carry  through  the  devel¬ 
opment  of  the  algorithms  to  the  point  where  they  are  complete  and 
no  further  work  be  necessary  on  algorithm  development. 

1.3  TECHNICAL  APPROACH 

The  overall  technical  approach  in  this  study  is  to  examine  the 
method  of  Baussus  von  Luetzow  in  detail  and  develop  all  the 
necessary  algorithms  to  work  in  conjunction  with  the  Litton 
inertial  surveying  systems.  The  algorithms  are  developed  taking 
into  account  not  only  the  present  state  of  the  hardware  but  also 
future  hardware  improvements.  The  real-time  software  on-board 
the  Litton  inertial  surveying  systems  is  an  important 
consideration  since  the  design  of  post  mission  estimation  methods 
must  invariably  take  into  account  any  on-line  corrections.  The 
approach  taken  in  this  study  is  to  design  the  algorithms  for 
post-mission  processing  in  a  way  that  takes  into  account  the  on¬ 
line  corrections  made  by  the  on-board  software  but  does  not 
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require  any  changes  or  modifications  to  the  on>board  software 
thereby  minimizing  the  impact  on  real-time  software  changes. 

1.4  OVERVIEW  OF  REPORT 

This  report  is  organized  as  follows.  Chapter  2  investigates  the 
applicable  error  models.  In  this  chapter r  first  the  general 
local  level  north  pointing  error  model  is  reviewed ^  which  is  then 
approximated  for  land  survey  vehicle  applications  from  which  a 
reduced  set  of  error  equations  are  obtained  based  on  further 
appropriate  assumptions.  Closed  form  solutions  of  the  reduced 
set  of  error  equations  are  presented  in  Chapter  3  wherein  first 
the  time  invariant  dynamics  matrix  solution  is  written  followed 
by  the  appropriate  eigenvalues  and  eigenvectors  necessary  for  the 
solution.  In  Chapter  4  the  transition  matrices  during  vehicle 
stop  periods,  motion  periods  and  Kalman  filter  updating  are 
obtained.  The  observation  equation  is  derived  in  Chapter  5 
wherein  first  a  generalized  form  at  each  point  is  presented  which 
is  then  reduced  to  separate  the  unknown  gyro  drift  cates  from  the 
unknown  vertical  deflections.  In  Chapter  6  the  different 
etimation  methods  are  outlined  for  the  initial  conditions,  gyro 
bias,  unknown  coefficients  and  finally  the  vertical  deflec¬ 
tions.  Summary  and  recommendations  are  discussed  in  Chapter  7. 
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2.0  ERROR  MODELS 


2.1  LOCAL  LEVEL  NORTH  POINTING 

The  central  error  dynamics  of  concern  here  is  that  of  the 
inertial  system.  Huddle  (1982)  has  presented  the  pertinent 
equations  along  with  suitable  approximations  to  be  used  for  an 
on-line  Kalman  filter  design.  For  a  local  level  north  pointing 
inertial  navigation  system  the  error  differential  equations  are 
(for  the  horizontal  channels  only) : 


5<D 

m 

-  <SPg  +  Pjj  (5X  sin  ♦)  -  (6\  cos  <!>) 

(S'acos* 

m 

6pjj  +  P26«  +  Pg  (6X  sin  ♦) 

6Vj. 

9 

An<^z  ”  g’J’n  +  (Pz  "^^N 

+  VjjSpj  +  2Vjjnj|5<t'  + 

5Vn 

9 

+  9‘^e  ”  tPz'*'^^Z^  *^^E 

"VgSpj  -  2Vjjnjj6<t  +  Vjj 

9 

<5PE  ”  (^11  +  ^N^'^z  ^^z  ®Z^  "^N 

fljl  (5X  sin  $)  -  («2  +  P2)  (<SX  cos  $) 

+  eg 

^*N 

9 

5PU  ”  {^2  +  PZ^  '^E  Pe'^Z  “  ^N 

0*Z 

9 

6pz  "  pe<i>n  pn^  “^e  "*■  ^Z 

where  figure  2-1  is  a  block  diagram  of  the  error  equations  and 
table  2-1  gives  a  definition  of  all  the  variables. 
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(P2+  2Sl^  SV,^ 
2V^ 


*  ( 122'^  P^  *  Pe^Z“  ^^2®^ 


5XC0S<^ 


Sp2  •  Sp^  TAN  SEC^  ^ 

- Pb  ^N  ♦  <^|  ♦Pn*  ^E  ♦ 


“  Ag0Z'^*^E 


Viz*  2n2)  5Vg 

Vb«^ 

2S2|,Vg5« 


p,^  (5X  SIN  «)  •«■  P2  (6X  COS 


-  ♦  P^)  02 ’*■  i^*P2^  0(l| 

4>  R,y  (8X  SIN  <0)  -  (122  Pz)  (fix  COS 


Figure  2-1.  Local  Level,  North  Pointing  Inertial  Error 

Block  Diagram 
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TABLE  2-1.  DEFINITION  OF  LOCAL  LEVEL  NORTH  POINTING 

ERROR  VARIABLES 


Pe  ■  ”^n/® 

a  East  craft  rate 

pn  ” 

a  North  craft  rate 

a  Vertical  craft  rate 

g 

a  Vertical  gravity  vector  component 

R 

a  Earth's  mean  radius 

Ve»  Vn 

a  System's  east,  north  velocity 

a  Geographic  latitude 

n 

a  Earth's  inertial  angular  velocity 

Qjl  •  ^cos$ 

a  North  component  of  Earth's  angular  velocity 

^2  *  nsin<( 

a  Vertical  component  of  Earth's  angular 
velocity 

Ae#  Aji 

a  East,  north  components  of  vehicle's  specific 
force 

5pg  «  -6Vjj/R 

a  East  craft  rate  error 

<5Pn  •  -SVe/R 

a  North  craft  rate  error 

6p2  ■  6Pu  tan<f 
+  6<Ppjjsec^<t 

a  Vertical  craft  rate  error 

SVg,  6Vn 

a  East,  north  velocity  error 

5<t 

a  Latitude  error  (North  angular  position 
error) 

6X 

a  Longitude  error 

6  X  cos  $ 

a  East  angular  position  error 

*<’e»  '*'n» 

a  East,  north,  vertical  platform  attitude 
error 

Ve»  ^N 

a  Composite  east,  north  accelerometer  error 

^E'  ^N'  ^Z 

a  Composite  east,  north,  vertical  gyro  drift 
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2.2  LAND  SURVEY  VEHICLE  APPROXIMATIONS 

Considering  the  fact  that  the  survey  vehicle  moves  slowly  over 
relatively  short  distances  various  approximations  can  be  made 
without  impacting  on  the  validity  of  the  error  equations.  First, 
the  errors  due  to  errors  in  the  corriolis  corrections  can  be 
ignored.  These  are  the  errors  proportional  to  <SV{|,  SV£,  6p2  and 
6<(.  Second,  the  errors  proportional  to  position  error  (6A, 

64)  can  be  ignored  except  for  ^i|64,  which  is  an  important 
azimuth,  level  coupling  term.  Because  of  the  accuracy  of 
initialization,  the  periodic  null  velocity  updating  and  the  low 
vehicle  speed,  these  position  error  coupling  terms  represent  very 
small  equivalent  gyro  drift  rates.  Finally  those  terms 
containing  p^,  p^  and  P2  can  be  ignored  because  of  the  low 
vehicle  speed  compared  to  earth  rate.  This  reduces  the  error 
equations  to 

R*64  »  6Vj, 

R(5’x  cos  4)  «  6V£ 

avj.  »  An42  -  +  gn  +  Vg 

5’Vjj  ■  -A£42  +  g4£  -  gc  +  Vjj  (2.2) 

4g  ■  -6Vjj/R  -  ^jj42  +  ■*" 

4jl  ■  5Vg/R  -  ^2'^E  ^N 

42  ■  (1/R  tan  4)  6Vg  +  ^(^64  + 

where  the  terms  gn  and  gC  (the  north  and  east  deflections)  have 
been  explicitly  extracted  from  Vg  and  7[j  respectively.  These 
equations  agree  with  those  of  Baussus  von  Luetzow  (1983) . 
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2.3  FURTHER  ASSUMPTIONS  TO  OBTAIN  REDUCED  SET 

The  following  assumptions  ace  invoiced: 

a.  Under  accelerometer  bias  calibration  7^  and  are 

assumed  to  be  calibrated  out. 


b.  The  horizontal  accelerations  A^  and  A^  are  neglected  for 
the  time  being. 

c.  Longitude  error  dynamics  is  neglected  since  the 
differential  equations  for  the  horizontal  velocity 
errors  have  no  coupling  to  longitude  error  6X. 


Under  the  above  assumptions  the  error  equations  given  by  (2.2) 
reduce  to 


R6<t 

iz 


»  +  g<*)j,  -  gC 

-  SVj, 

■  "  g't’n  +  gn 

®  (  1/R  tan  4* )  SVg  +  +  ^N^E  ^ 

*  "SVg/R  -  ^2‘^’E  ^N 


^E 


-6Vjj/R  -  ^Z'^N  ^E 


(2.3) 


which  can  be  written  as 
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3.0  CLOSED  FORM  SOLUTION 


3.1  TIME  INVARIANT  DYNAMICS  MATRIX  SOLUTION 

As  can  be  easily  seen  from  (2.4)  the  coefficients  of  the  dynamics 
matrix  A  include: 

a.  Mean  radius  of  the  earth,  R 

b.  Earth's  inertial  angular  velocity,  ^ 

c.  Geographic  latitude, 

For  the  applications  under  consideration  it  can  be  assumed  that 
R,  n,  <(  are  constant  between  stops  of  the  survey  vehicle.  This 
leads  to  a  time  invariant  dynamics  matrix  A  for  which  the  closed 
form  solution  to  (2.5)  is  given  by  Brogan  (1974)  as 

y(t)  «  e^5(0)  +  e^^^"^^b(T)dT  (3.1) 

0 


which  reduces  to 


y(t)  «  +  A"^(e^^-I)  bg 


(3.2) 


where  b(0)  was  assumed  to  be  constant  over  the  integration 
interval. 
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Now,  if  are  the  eigenvalues  of  A  and  the  corresponding 
eigenvectors,  then 

A^i  ■  (3.3) 

such  that 


(3.4) 


or 


AM  »  MA 


(3.5) 


where 


M  = 


(3.6) 


and 


0 


0 


(3.7) 
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Therefore,  from  (3.5) 

A  »  (3.8) 

which  leads  to 

e^^  =  I  +  At  +  ^  A^t^  +  ... 

»  I  +  MAM"^t  +  MAM"^MAM“^t2  +  ... 
a  +  MAtM”^  +  m|  A2t2M"’^  +  ... 

»  M  (I  +  At  +  j  A^t^  +  •••)  M  ^ 

-  Me^^M"!  (3.9) 


Similarly, 


A-l(eAt_i) 


L-1 


(I  +  At  +  J  A^t^  +  ...  -I) 


A“1  (At  +  i  A^t^  +  . . .) 


It  +  At^  +  . .  . 
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It  +  ^  MAM“^t2  +  . 


+  M-j  + 


=  M  (It  +  -I  At^  +  .  ..) 
=  MA“^  -  I)  M“^ 


(3.10) 


Hence,  substituting  (3.9)  and  (3.10)  in  (3.2)  yields 

y(t)  -  Me^^M“lyQ  +  MA“^(e^^-I) 

-  Tyg  +  H-bo 

where 

T  »  Me^^M"^ 

4'  »  MA"^(e^^-I)  M"^ 


(3.11) 


(3.12) 

(3.13) 
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Recall  that 


yi(t) 


5V„(t) 


y2<t) 


6VE(t) 


y3(t) 


R6$(t) 


y(t) 


y4(t) 


ysCt) 


U(t) 


ye^t) 


<l>E{t) 


(3.14) 


For  each  individual  element  of  y(t)  of  (3.14)  denoted  as  yj^(t)  we 
have 


yi(t)  «  ^  M(i,j)  e  ^  ^  M"^(j,k)  y^Oc) 

j»l  k»l 


+  ^  M(i,j)  (e  ^^-1)  ^  M’^(j,k)  bQ(k) 


X  *  1^2f  % . .  f  S 


(3.15) 
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3.2  DETERMINATION  OF  EIGENVALUES /EIGENVECTORS 

The  dynamics  matrix  A  given  by  (2.4)  has  a  characteristic 
equation  as 


x®  +  x^  [2^1  +  _  a^nfcos^^  »  o 

s  s  s  s 


(3.16) 


which  has  roots 


*ii2  ,  iin', 


(3.17) 


where 


5^- 


s 


<f) 


1/2 


(3.18) 


is  the  Schuler  frequency  and 


n' 


5  {“s  *  (1  +  2  cos^t)  + 


*  {^S  *  (1  +  COS^'f)  I 


ll/2 


1/2 

(3.19) 

(3.20) 


and 


[l  {^s  ^^s^^  (1  +  2  cos2$)  +  1  (a^  +  ^2) 


1  1/2 


(3.21) 


Q  cos  4) 


(3.22) 
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The  eigenvectors  are 

-4  (X?  + 


xi  *  “;> 


g(2  sin4 


f(X?  +  +  X?S2^sin^$  j/X.fl  cos$ 

\  X  S  X  /X 


-  Xj^f2sin<I> 


X^  + 

X  s 


(3.23) 


where  Uj^  refers  to  the  eigenvector  associated  with  the  ith 
eigenvalue.  Thus  the  modal  matrix  M  is  now  completely 
specified.  To  specify  the  eigenvectors  of  the  adjoint  matrix 
is  necessary.  The  adjoint  matrix  is  given  by  which  has  the 
same  eigenvalues  as  .  A.  Let  the  eigenvectors  of  the  adjoint 
matrix  A*^  be  represented  by  Then 

A*0^  ■  ^i^i  (3.24) 
which  leads  to 


aT 


'2  I 


.1  e 


"] 


(3.25) 
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or 


A^N  »  NA 

where  the  modal  matrix  for  the  adjoint  matrix  is 

N  ■  ^0]^  1  }  •  •  •  •  I  6ii3 

and  the  eigenvalue  matrix  A  is  same  as  before  given  by  (3 
Thus,  from  (3.26) 

A**^  »  NAN"^ 

which  leads  to 

A  »  (N^)”^A 

Comparing  (3.29)  with  (3.8)  leads  to 

Thus,  solution  of  the  eigenvectors  for  the  adjoint 
completely  specifies  the  inverse  modal  matrix. 


(3.26) 

(3.27) 
.7) 

(3.28) 

(3.29) 

problem 
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The  eigenvectors  of  the  adjoint  problem  are 


(xj  +  (a^cos^* 


X?)/R 


2Af  flsin  $/R 


il^coaiX.  (XT  +  nf)/R 
11  s 


9i  ■  at 


-  Qcos<&xJ  (xj  +  (2^) 

X  X  S 


n  sin  $X^  (X? 


xhxf  +  flg) 

11  s 


where 


(3.30) 


4X’J2;2nJ  3in2^  ^  2(X?  +  A  (xj  +  ^2^2  cos2$)/X. 

X  S  X  5  '  X  S  X 


(3.31) 


is  the  normalizing  factor  such  that 


T 

®i  •  ^3 


(3.32) 
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4.1  VEHICLE  STOP  PERIODS 

During  vehicle  stop  periods  the  horizontal  accelerations  A^  and 
A{]  are  assumed  to  be  zero.  Therefore,  the  dynamics  matrix  A  of 
(2.4)  is  exact  during  the  stop  period.  Consequently,  the  stop 
period  transition  matrices  for  the  initial  conditions  yQ  and  for 
the  drivers  bQ  are  equal  to  those  given  by  (3.12)  and  (3.13). 
Therefore,  during  stop  periods 

Tg  -  T  (4.1) 


and 


4-g  -  'F 

4.2  VEHICLE  MOTION  PERIODS 


(4.2) 


During  the  motion  period  the  horizontal  vehicle  accelerations  Ag 
and  Ajf  are  not  zero.  Thus,  in  order  to  compensate  for  setting  Ag 
and  Ajj  to  zero  in  the  dynamics  matrix  A  we  try  a  perturbation 
addition  to  the  solution  y(t). 


Comparing  (2.2)  and  (2.3)  the  neglected  terms  are  identified  as 
•  -  Ae<I>z  (4.3) 

«Ve  -  Ai,<^2  (4.4) 
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Thus, 


6Vi, 


y*  Ag(T)  <J)2(t)  dT 
0 


(4.5) 


and 


6Vg 


y*  Aj,(t)  ♦zC'c)  dT 
0 


(4.6) 


The  above  integrals  (4.5)  and  (4.6)  could  be  integrated 
numerically  given  the  functional  form  of  Ag  and  A^^.  However, 
since  the  integration  time  is  expected  to  be  no  more  than  ten 
(10)  minutes  a  Taylor  series  expansion  for  <)>2  appropriate. 
But  since  every  motion  period  is  bounded  on  either  side  by  a  stop 
period  it  is  likely  that  the  acceleration  of  the  vehicle  will  be 
close  to  an  odd  function  about  the  midpoint  of  the  motion  period 
interval.  For  example,  figure  4-1  is  one  possible  form  of  the 
acceleration  profile  during  the  motion  period,  bounded  on  either 
side  by  stop  periods.  For  such  an  acceleration  profile  as  shown 
in  figure  4-1,  its  functional  form  is  given  by 


a(t) 


+  A 


0  1  t  <  I 


(4.7) 


-  A 


1  1  T 


This  suggests  expanding  the  Taylor  series  for  <t>2  about  the 
midpoint  of  the  motion  period  interval,  T.  Thus, 
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t) 


Let  us  first  examine  the  third  term,  <>22  above  expansion 

(4.8)  in  conjunction  with  the  assumed  acceleration  form  given  by 


(4.7)  . 


y^a(t)  <l>-,(t)  dt 


^/2  ,  d‘<j)„(t) 

y  Aj — ^  (t 

0  .  dt^ 


T  ^ 
j)  dt 


^  .a  A.  ^ 


(t  -  j)  dt 


t  «  T/2 


{ 

0 


T/2)^dt  -  y*  (t 
T/2 


-  T/2)‘^dt 


t  -  T/2 


A 


2  dt^ 


I  -T/2  ^  ^  0  ^ 


tj^  »  t  -  T/2 


t  -  T/2 
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As  expected,  for  the  assumed  acceleration  profile  the  third  term 
of  the  Taylor  series  integrates  to  zero.  The  actual  acceleration 
profile  will  not  be  precisely  as  given  in  (4.7).  However,  in 
order  for  the  vehicle  to  execute  a  stop-motion-stop  process  the 
actual  acceleration  profile  will  be  similar  to  (4.7)  representing 
an  odd  function  about  the  midpoint.  For  any  odd  function,  the 
third  term  of  the  Taylor  series  will,  therefore,  integrate  to 
near  zero.  Thus,  keeping  only  the  first  two  terms  of  the  Taylor 
series  we  have,  for  any  acceleration  profile  a(t). 


y*  a{t)  tt>.(t)  dt 

A  ^ 


4>2(t) 


d(p2(t) 


(t  -  T/2)  }  dt 


t  ■  T/2 


t  -  T/2 
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♦7(t)  u  dt 


d(f2(t) 


J  a(t)  (t  -  T/2)  dt 


t  «  T/2 


J  a(t)  dt 


d<t,(t) 


I  t  dt  - 1  a(t)  dt^ 


t  «  T/2 


t  »  T/2 


'I  -It- 


d(i)2(t) 


a(t)  dt  + 


y^a(t)  t  dt 


t  »  T/2 


t  »  T/2 


2  — dt  ^t  dt 


y’  ^  t  dt 


t  »  T/2 


t  «  T/2 


-  d<>-(t)  )  T  d(j>2(t) 

0  ^-it- 


t  »  T/2  t  »  T/2 


-|(v(t)t''-  y’%(t)  II  at} 

V  0  0  J 

'  V - - / 

fc  Si  t/2 

'  integration  by  parts 


T  d4»2(t) 


-f-lt 


<V(T)  -  V(0) 


d(D-(t)  r 

+  It-  ‘^(V(T)T 


t  «  T/2  t  »  T/2 


»0 

•  Stop  Period  »  T/2 

•begin  &  end  ^ - 

velocities 


V(0) 

»0 


■  “} 


d<D2(t) 


t  •  T/2 


P(t)  -  P(0) 


(4.10) 
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Hence,  using  (4.10)  we  have  for  (4.5)  and  (4.6)  respectively 

d<t>. 

6Vfj  »  +  (E(T)  -  E(0)) 

t  »  T/2 

d(p„ 

6Ve  -  -  (N(T)  -  N(0)) 

t  »  T/2 

where 


E(0),  E(T)  -  East  position  of  the  vehicle  at  the  beginning 
and  end  of  the  motion  period 

N(0),  N (T)  -  North  position  of  the  vehicle  at  the 
beginning  and  end  of  the  motion  period 
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To  evaluate  — 

t=T/2 


utilize  (3.14)  for  i»4  such  that 


(J)2(t)  »  y  (t) 

^  i»4 


+ 


6 


M(4,j) 

j-1 


(e 


Xjt_ 


1) 


6 

k»l 


(j»k) 


bo(lc) 


Therefore, 


d4)2 

dt 


t=T/2 


X.t 
(e  J  ) 


t»T/2 


6 

Y  M”^(j,k)  yo(k) 
k=l 


6 

+  Y  M(4,j) 

j-1 


1  _d 
X.  dt 


1)  I 

t=T/2 


6 

Y  M"^(j,k)  bQ(k) 
k=l 


X.e 


XjT/2 


6 

Y  M"^(j,k) 

k»l 


+ 


6 

Y 

j-1 


■ X.T/2 
e 


6 

Y  M“^(j,k)  bgCk) 
k-1 
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The  perturbation  solution  for  motion  periods  affects  only  and 
SVg  and  can,  therefore,  be  written  as 


f  X4T/2  M 

5yi(t)  »  ^j®  ^  2-  **  yoCls) 

^j»l  k-1 


X^T/2  ®  1 

L  ‘ 

k»l 


®  X.T/2  ®  \ 

+  ^  M(4,j)  e  J  Zi  **  "^(jA)  bQ(k)| 

3^1  -  ’  ' 


(4.15) 


where 


i  1,2 


6P4  >  <  (E(T)-E(O))  i  »  1 


-(N(T)-N(O))  i  «  2 


(4.16) 


m , 


The  total  solution  during  motion  periods,  y£(t) 


yi(t)  -  yi(t)  +  6y.(t) 


where  y^(t)  is  as  per  (3.15)  and  5yj^(t)  as  per 


is  given  by 

(4.17) 


(4.15) . 
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Bence 


(t)  «J^M(i,j)e  J  ^(j,k)  +  6Pi  2*M(4,j)\je  ^  2^  M 

^j«l  k«l  j»l  k»l 


(k) 


m 


®  X^T/2  ^ 


+  J2^M(i,j)  (e  J  -1)  2^M  -^(jrk)  +  6Pi  2^M{4,j)e  ^  2^  M  -^(j^k)^ 

^-1  ^  k-1  j-1  k-1  ^ 


'm 


•  T„yo  +  4'„bo 


(4.18) 


(4.19) 


4.3  KALMAN  FILTER  UPDATING 

The  real-time  software  is  assumed  to  have  a  Kalman  filter  which 
periodically  updates  its  states  using  null  velocity  measurements 
during  vehicle  stop  periods.  The  Kalman  filter  states  in  the 
real-time  software  are  not  necessarily  the  same  as  those  selected 
here  as  initial  conditions  y  or  the  system  drivers  b.  Thus,  let 
the  Kalman  filter  states  be  represented  as  vector  z  different 
from  y  or  b.  But  let 

y  ■  Fz  (4.20) 


and 


b  ■  Gz  (4.21) 
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Then  the  incremental  update  for  the  initial  conditions  is 

»  FAz  (4.22) 

Let  K  be  the  Kalman  gains »  and  B  the  observation  matrix  of  the 
Kalman  filter.  Then,  the  Kalman  filter  state  update  increment  is 
given  by 

Az  «  KHz  (4.23) 

Therefore 

Ay  «  FKHz 

«  FKHF**ly  (4.24) 

Hence,  denoting  superscript  **  as  prior  to  update  and  +  as  after 
update, 

y+  m  y"  -  Ay 


-  (I  -  FKHF“l)y"  (4.25) 

Thus,  the  transition  matrix  for  the  initial  conditions  at  every 
update  time  is 

Tu  -  (I  -  FKHF"^)  (4.26) 

Similarly,  the  transition  matrix  for  the  system  drivers  at  every 
update  time  is 

4-u  -  (I  -  GKHG“^)  (4.27) 
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4.4  STOP/MOTION/UPDATING  COMBINED 


The  overall  transition  matrix  T  needs  to  be  examined  with  respect 
to  whether  the  vehicle  is  in  motion  or  stationary.  Within  the 
stop  period  the  real-time  Kalman  filter  utilizing  zero  velocity 
updates  also  needs  to  be  taken  into  account.  The  total  vehicle 
traverse  is  broken  up  into  multiple  legs,  each  leg  includes  a 
stop  period  and  a  motion  period  as  shown  in  figure  4-2.  Within 
the  stop  period  U  zero  velocity  updates  of  the  real-time  Kalman 
filter  are  performed. 

Therefore,  the  transition  matrix  from  tQ  to  tj^  representing  a 
typical  leg  of  the  survey  traverse  is  given  as 


T(ti,to)  ■  '^n^^l'^m+l^'^s^^m+l'^m^^u^^m'^m^^s^^m'^m-l^ 


(4.28) 


Similarly  for  4'. 
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STOP  PERIOD 


MOTION  PERIOD 


Figure  4-2.  Stop/Motion/Updating  Periods 
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5.0  OBSERVATION  EQUATION 


5.1  GENERALIZED  FORM  AT  EACH  STOP  POINT 

The  transition  equation  from  time  0  to  time  t  can  be  generalized 
for  any  interval  (n*-l)  to  n  as 


y(t„) 


T'(tn,t„.i)  y(t„.i)  +  4'(t„,t„.i)  b(tn.i) 


(5.1) 


^n  ^  'pn^lyn*!  ^  v^n*l^n*l 


This  can  be  generalized  to 


(5.2) 


n-1  n-2  n-1 

IT  tV  *  £  77  +  ♦"-v-i 

i-0  j-0  i»j+l 


A"y®  +  £ 


(5,3) 


where. 


n-1  . 

TT  t" 

i-O 


(5.4) 
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and 


n-1  . 

TT  4*^ 
i«j+l 


0  1  j  1  n-2 
j  »  n-1 


(5.5) 


Using  the  notation 


^  (i»j^  - ^  (i/j)^^  element  of  matrix  A 

X|j  - ►  element  of  vector  x 

we  have 

*  z  *  r 

k»l  j»0 

which  represents  the  value  of  the  ilth  element  of  the  state  vector 
y  at  stop  time  t^^  as  a  function  of  the  initial  condition  vector 
elements  y®  and  the  driver  at  the  stop  vector  elements  . 

5.2  LINEAR  COMBINATION  OF  UNKNOWN  DEFLECTIONS 

The  observation  equation  (5.6)  includes  the  driver 


6 

Bj()l,k)  b^  ,  i  »  1,2, ...6 

k»l 


[-gc^ 


gn- 


41 


(5.7) 
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Here,  the  deflection  at  each  stop  point  i.e.  are 
expressed  as  a  linear  combination  of  the  deflections  at  all  the 
desired  points. 


Let  there  be  N  spatial  points  where  it  is  desired  to  estimate  the 
deflections.  Then,  the  deflections  at  each  stop  point  can  be 
expressed  as  a  linear  combination  of  the  deflections  at  all  the 
desired  points.  Thus, 

N  N 

■  Z  *  Z 

k-1  k»l 


‘^jk^k 


(5.9) 


N  N 

•  Z  ♦  Z  “"jk^k 

k«l  k»l 

where 

^k'  ^k  ~  deflections  at  the  desired  points 
Cj,  Hj  >  deflections  at  the  stop  points. 


(5.10) 


The  terms  with  in  the  determination  of  and  vice  versa, 

enter  because  the  deflections  are  strongly  cross  correlated. 


Defining 

'2j-l 

-  o 

-  nj 

(5.10) 

'2j 

(5.11) 

and 

'2k-l 

•  ^k 

(5.12) 

'2k 

.  n,5 

(5.13) 
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5.4  SEPARATION  OF  GYRO  DRIFT  RATES  FROM  UNKNOWN  DEFLECTIONS 

Substituting  {5.15)-{5.19)  in  (5.7)  yields  for  any  general  stop 
point  j 


2N 

k-1 

. 

2N 

+gn^ 

^  “2i  k 

k-1 

0 

> 

0 

Z 

^2 

1 

mm 

"n 

/■i  _ 

"e 

. 

*  " 

p  — ^ 

0 

"®2j-l,l  ■"'‘2J-1,2  "“2j-l,3””""2j-l,2N 

"'l 

0 

^‘2j,2  “2.1,3 . “2i.2N 

^2 

0 

n  0 

= 

+K 

J 

'Z 

0 

"'N 

• 

0  0 

r 

2N 

L  J 

L  J 

-  C  +  DjX  (5.20) 

which  separates  the  unknown  constant  gyro  drift  rates  C  from  the 
unknown  deflections  X. 
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Substituting  (5.20)  in  (5.3)  yields  the  final  generalized  form  of 
the  observation  equation  as 


A"y0  + 


n-1  n-1 

J  B^C  +  g  ^  B^DjX 
j»0  j*0 


*  If2f...f6 


(5.21) 


where  A"  and  b"  are  given  by  (5.4)  and  (5.5)  respectively.  In 
the  next  chapter,  methods  of  estimating  y®,  C,  Dj  and  X  are 
explicitly  outlined. 
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6.0  ESTIMATION  METHODS 
6.1  INITIAL  CONDITION  SPECIFICATIONS 


At  survey  traverse  initial  time  t«0  the  initial  deflections  are 
assumed  to  be  known  i.e.  C(0)  and  n(0)  .  Therefore,  under 
consideration  of  plumbline  leveling 


6Vj^(0) 


6Vjj(0) 


R(S<K0) 


(6.1) 


.^2(0) 


^,(0) 


Thus  all  the  elements  of  in  the  observation  equation  are  now 
specified. 


6.2  CONSTANT  GYRO  BIAS  ESTIMATION  FROM  TERMINAL  DATA 


At  the  termination  of  the  survey  it  is  assumed  that  the  north- 
south  deflection  (^(T)),  east-west  deflection  (n(T)}  and  platform 
azimuth  error  (<t)2('^))  available. 


Thus,  at  the  survey  terminal  time  t»T, 


y"-4  " 

(6.2) 

yy 

y^-s 

■  n(T) 

(6.3) 

y" 

y£-6 

<Dg(T) 

■  ?(T) 

(6.4) 

USE  OR  OISCLOSUmC  OF  DOCUMENT  DATA  IS  SUBJECT  TO  THE  RESTRICTION  ON  THE  Tl TIE  PAGE  OF  THIS  DOCUMENT. 

6-1 


Appueo  sciEMce  analytics,  me. 


(6.5) 


But  for  4  ^  A  £  6  the  observation  equation  reduces  to 

y?  ■  *  i 

j-0 

due  to  the  non’-coupling  of  the  deflections  X  into  <t>2f  <]>£;  as 

is  evident  from  the  structure  of  the  Dj  matrix.  These  three 
equations  are  then  solved  to  obtain  the  three  unknowns  in  the 
vector  C. 


6.3  COEFFICIENT  ESTIMATION  VIA  STATISTICAL  COLLOCATION 

From  (5.14)  the  relationship  that  expresses  the  deflections  at 
the  stop  point  as  a  linear  combination  of  the  deflections  at 
the  desired  points  we  have  as  an  estimate 
2N 

I  "•«> 


A. 

r. 


k»l 


Minimizing  the  mean  square  error  between  r^  and  r^  leads  to 


“l,l  "‘1,2  ••••  “l,2N 


“2,1  “2,2  - “2,2N 


“2M,  1  ®2N,2  - '‘'‘2M,2N 


.... 

*^1  ’  ‘^2N^ 

.... 

E(r2r2^) 

F.(r2Nri) 

^^'^2n'^2N^ 

•••• 

E(rir2jj) 

£(^2^2^  •••• 

E(r2'^2N^ 

.... 

(6.7) 
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where  E  is  the  statistical  expectation  operator 


Therefore, 


[a]  -  [E(rr)]  [E(rr)J“^ 


(6.9) 


where  the  needed  covariances  can  be  estimated  using  any  one  of 
the  many  statistical  covariance  models  in  practice  (Bose  and 
Kouba,  1983)  .  Thus,  all  the  necessary  elements  of  Dj  in  the 
observation  equation  can  be  estimated. 


6.4  LEAST  SQUARES  ESTIMATION  OF  DEFLECTIONS 


The  fundamental  observation  equation  for  the  least  squares 
estimation  of  the  deflections  is  given  by 


n-1  n-1 

A"y®  +  b"c  +  9  ^  BjDjX 

j»0  j»0 


(6.10) 


where  y“  is  known  from  initial  conditions  at  t»0  such  that 


[o  0  0  0  n(0)  C(0)J  , 


(6.11) 


the  vector  C  given  by 


[o  0  0  €e]T 


(6.12) 
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is  estimated  £rom  terminal  conditions  .02 (T) ,  C(T) r  n(T),  and  the 
elements  of  Oj  given  by 


■“2j-l,l  ■“2j-l,2  ■“2j-l,2 

“2j,l  °‘2j,2  °‘2j,3 


““2j-l,2N 

“2j,2N 


(6.13) 


is  estimated  using  statistical  least  squares  collocation  as 
discussed  earlier. 


Thus  the  observation  equation  can  be  rewritten  as 


yj  -  AnyO 


n-1 

Y. 

j»0 


9  £  bOd.; 
j-0 


(6.14) 


where 


(6.15) 


(6.16) 


at  every  stop  point  (1  n  £  M)  are  the  data  used  in  this 
estimation  procedure.  The  above  observation  equation  can  be  cast 
into  the  form 


(6.17) 
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where 


n-1 

y“  -  A”y®  -  bJc 
j.O 


(6.18) 


8*  A 

Z 


(6.19) 


The  estimate  is  simply  obtained  via  a  least  squares  solution  as 


X  «  (h’^H)“Vy 


(6.20) 


where 


[Ci 


^2N  '^2nJ'^ 


(6.21) 


are  the  unknown  deflections. 
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7.0  COHCLUSIONS 


7.1  SUMMARY 

A  new  optimal  data  reduction  method  for  estimating  the 
deflections  of  the  vertical  was  outlined.  Highlights  include: 

a.  Incorporates  dynamical  interaction  of  the  two  level 
channels  of  the  inertial  system. 

b.  Uses  existing  real-time  zero  velocity  Kalman  filter 
updating  during  stops  along  a  traverse. 

c.  Exploits  statistical  collocation  techniques  to  preserve 
correlations  between  the  two  components  of  the 
deflections  of  the  vertical. 

d.  Estimates  approximate  gyro  bias  utilizing  terminal 
azimuth  and  deflection  values. 

e.  Performs  least  squares  estimation  of  the  unknown 
deflections  utilizing  all  data  simultaneously. 

The  data  necessary  to  implement  the  method  includes: 

a.  Inertial  system  horizontal  velocity  errors  at  each  stop. 

b.  Inertial  system  real-time  Kalman  filter  update  gains 
onlyr  no  need  for  real-time  covariance  data. 
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c.  Astrogeodetic  initial  and  terminal  deflections  of  the 
vertical. 

d.  Terminal  Platform  asimuth  error  observation. 

7.2  RECOMMENDATIONS 

It  is  recommended  that  software  be  developed  to  implement  the 
algorithms  derived  herein.  Such  a  software  package  will  be 
useful  and  significant  for  future  vertical  deflection 
determination  and  densif ication  in  support  of  the  Defense  Mapping 
Agency#  D.S.  Army  and  U.S.  Air  Force. 
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